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Sammandrag: 

En industrirobot (2) har ett flertal relativt varandra rdrliga delar (21-25). 
Roboten ar utrustad med en lagesgivaranordning som har en givare (30) som 
ar monterad pa robothanden (27). Givaren mottar signaler fran en uppsattning 
(Hl-im) av minst tre ljjuskallor med kanda lagen. Givaren avkanner rikt- 
ningarna fran givaren till de olika 1 juskallorna , och ur dessa riktningar 
samt ljuskallornas kanda lagen beraknas robothandens lage och eventuellt 
orientering relativt ljuskallorna av i utrustningen anordnade beraknings- 
organ. 
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Foreliggande uppfinning avser en industrirobot med ett flertal relativt var- 
andra rorliga delar. 

Vid en industrirobot vill man av flera orsaker kunna bestamn.a robotens lage 
relativt ett kant koordinatsysten,. Den kanske viktigaste av dessa orsaker ar 
att man under drift onskar erhilla en lagesinf ormation son, kan aterkopplas 
till robotens styrsystem. Det hittills normalt anvanda sattet att erhaila 
den onskade lagesinf ormationen ar att anordna givare, t ex vinkelgivare , for 
var och en av robotens f r i hetsgrader och att med ledning av gi varsignalerna 
och de kSnda dimensi onerna hos robotens delar berakna robots, lage relativt 
robotens fastsattningspunkt . Detta satt bar dock flera nackdelar. Med ut- 
trycket "robotens lage" avses bar laget hos en viss del av roboten, vanligen 
robotens hand eller ett av roboten buret verktyg. 

For att ra- god noggrannhet hos lagesinf ormationen kravs hog noggrannhet hos 
givarna och hog mattnoggrannhet och sma glapp hos robotens mekaniska delar. 
Vidare kravs att roboten ar si kraftigt byggd att dess deformation under be- 
lastning blir liten. Dessa krav gor att roboten blir relativt tung och klumpig 
och far ett hdgt tillverkningspris . 

For att fa korrekt lagcsinformation relativt ett fast koordinatsystem krSvs 
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vidare att robotens fastsattning (t ex monteringen av robotens fot i ett 
golv) gors med hog noggrannhet. 

On inte tillverknings- och monteringstoleranser halls mycket sma uppstar 
ocksa problem med utby tbarheten , dvs det blir inte utan vidare mojligt att 
utan omprogrammering utbyta ett robotexemplar mot ett annat. 

Det blir vidare svart att med bibehallen noggrannhet erhalla ett storre 
arbetsomrade for roboten an det som erhalles nar roboteri star fast monterad. 

Uppfinningen avser att astadkomma en industrirobot med en lagesgivaranord- 
nxng som gor det mSjligt att erhalla hog noggrannhet hos lagesinformationen 
oberoende av tillverknings- och f astsattningstoleranser och oberoende av de- 
formationer hos robotens delar. Uppfinningen avser vidare att astadkomma en 
industrirobot, dar robotexemplar utan omprogrammering kan utbytas mot var- 
andra utan att nigra krav stalls pa sma tillverknings- och fastsattningstole- 
ranser. Ett ytterligare syfte med uppfinningen ar att astadkomma en industri- 
robot, vars lagesinformation ar oberoende av att laget hos robotens fastsatt^ 
ningspunkt ar kant , varigenom roboten kan tillatas rora sig godtyckligt inom 
en lokal och dess arbetsomrade kan goras mycket storre an vad som hittills 
varit mojligt. 

Uppfinningen avser vidare att astadkomma en enkel och robust givaranordning 
for alstrande av den onskade lagesinformationen. 



Vad som kannetecknar en robot enligt uppfinningen framgar av bifogade pat 



ent- 



krav . 



Uppfinningen skall i det foljande narmare beskrivas i anslutning till bifo- 
gade figurerl-7. Fig 1 visar ,n industrirobot med ett exempel pa en lages- 
givarutrustning enligt uppfinningen. Fig 2a visar principen for den pa 
roboten i fig 1 monterade givaren. Fig 2b visar den i givaren ingaende detek- 
torn. Fig 3 visar ett blockschema over lagesgi varanordningen och fig H visar 
hur den ar inkopplad till robotens styrsystem. Fig 5 visar vissa av de an- 
vanda koordi na terna och fig 6 de anvanda vektorbeteckni ngarna for 1 juskal- 
lornas och givarens lagen. Fig 7 visar- ett flodesschema for de berakningar 
som ur givarsignalerna ger robotens lage . 
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Fig 1 visar en industrirobot 2, som ar fast monterad pa ett underlag 1 , t ex 
ett golv. Roboten ar av i och Tor sig kand typ och har en fot 21. En pelare 
22 ar vridbar runt en vertikal axel i forhallande till foten 21 . En under- 
arm 23 ar vridbart lagrad till pelaren 22 med hjalp av en horisontell axel. 
En overarm 2k ar lagrad till underarmen 23 och en robothand 25 till over- 
armen 2^4 , bada raed hjalp av i figuren horisontella vr idningsaxlar . Vid 
robothanden 25 ar en mellandel 27 fast, vilken har ett verktygsfas te 28, 
som uppbar ett gripdon 29-. Pa mellandelen 27 ar en optisk givare 30 anord- 
nad , vilken pa nedan beskrivet satt anvands for att bestamma robothandens 
lage och orientering i rymden. Roboten har ett styrsystem 5, vilket mojlig- 
gor inprogrammering av ett rorelseschema hos roboten med atfdl jande drift 
av roboten i enlighet med detta rorelseschema. Styrsystemet hSmtar en 
successiv foljd av lagesbbrvarden ur ■ programmet , j&mfor dessa med avkanda 
arvarden for robothandens lage och driver motorerna i robotens olika axlar 
sa att robothanden foljer de inprogrammerade lSgesborvardena . For bestam- 
ning av robothandens lage och samverkan med givaren 30 ar en uppsattning 
ljuskallor Hl-UH anordnade. LjuskSllorna kan lampligen utgoras av lysdioder 
och ar sa anordnade att under drift av roboten minst tre och heist fyra av 
ljuskallorna hela tiden bef inner sig inom givarens 30 synfalt. Pa nedan 
narrnare beskrivet satt besta'mmer givaren 30 riktningarna hos syftlinjerna 
fran givaren till 1 juskSllorna . L juskallornas lagen i ett visst koordinat- 
system forutsatts kanda och matas lampligen in i styrsystemet vid pro- 
grammering eller installation av roboten. Ur dessa pa forhand kanda lagen 
och de av givaren 30 bestamda riktningarna beraknar styrsystemet pa nedan 
beskrivet satt givarens lage i det aktuella koordinatsystemet . Ljuskallorna 
kan exempelvis vara fast anbringade, och robotens lage beraknas da i ett 
fast koordinatsystem . Alternativt kan ljuskallorna anbringas vid ett 
arbetsstycke som roboten skall bearbeta eller hantera, och robotens lage 
erhalles da i forhallande till arbetsstycket . 

Pa i och for sig kant satt ar roboten forsedd med vinkelgivare i sina axlar, 
vilka till styrsystemet avger information om de aktuella vridningsvink larna 
i axlarna. Denna information anvands av styrsystemet for att fordela ett upp- 
tradande lagesfel pa de olika robotaxlarna . Dessa givare kan utforas med va- 
sentligt lagre noggrannhet an vad som varit nodvandigt vid tidigare ka'nda 
robotar, dar givarna anvands for bestamning av robothandens lSge . 

Av naturliga skal kan givaren 30 oftast ej placeras i den punkt , vars lage 
man egentligen vill bestamma. Denna intressanta punkt utgors ju t ex av 
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gripklorna hos ett gripdon, av spetsen hos en svetselektrod eller av eggen 
hos ett bearbetningsverktyg. Med kannedom om givarens lage i rymden och om 
robothandens orientering kan dock enkelt laget for den namnda punkten be- 
raknas. Information om robothandens orientering kan, som nedan narmare ■ 
skali beskrivas, erhallas med hjalp av lagesgi varsystemet enligt uppfin- 
ningen. Eftersom givaren 30 foretrSdesvis placeras sa nara den aktuella 
punkten som mojligt, krSvs ibland ingen storre noggrannhet hos bestamningen 
av handens orientering, och darfor kan alternativt de i robotaxlarna anord- 
nade vinkelgivarna anvandas for att ge information om handens orientering. 

For att mojliggora en lages- och orienteringsbestamning av robothanden obe- 
roende av dennas orientering relativt signalkallorna kan ytterligare givare 
anordnas pa handen pa sadant satt, att under robotens drift alltid minst en 
av dessa givare (eller bada tillsaramans) har ett tillrackligt antal ljus- 
kallor inom sitt synfalt. En sadan ytterligare givare Sr visad med streckade 
linjer i figuren och ar betecknad med 31. 

For bestamning av lage och/eller orientering hos ovriga robotdelar kan om 
sa onskas aven dessa delar forses med lagesgi varsystem enligt uppf inni ngen . 
Som ett exempel har i figuren visats hur en givare 32 ar anordnad pa under- 
armen 23. En uppsattning ljuskallor 45-48 ar sa anordnad att minst tre och 
heist fyra av ljuskaliorna under robotens drift befinner sig inom givarens 
32 synfalt. Den salunda for underarmen 23 anordnade lagesgi varutrustningen 
kan anvandas for bestamning av underarmens lage och orientering. Vid en ak- 
bar robot kan for bestamning av robotens aktuella lage':. inom sit t akomrade 
en dylik givare placeras pa t ex foten 21 . 

Alternativt till att montera mer an en givare pa robothanden kan givarut- 
rustningen forses med fler Sn de fyra i fig 1 visade ljuskaliorna. Ljus- 
kallor anordnas da i tillrackligt antal, t ex sex-Stta stycken, och med 
sadana 13gen att, oberoende av robothandens lage och orientering, alltid 
minst tre eller heist fyra av "ljuskaliorna befinner sig inom givarens syn- 
falt. Som nedan skall beskrivas anvander gi varsystemet for bestamning av 
lage och orientering tre at gangen av ljuskaliorna. Roboten kanner hela 
tiden till sitt lage och givarens orientering och styrsystemet kan darfor 
programmers att i varje lage valja ut och for lagesbes tamningen anvanda 
tre inom givarens synfalt lampligt placerade ljuskallor. Som visas i fig 1 
har styrsystemet en signalf orbindelse med ljuskaliorna och ar anordnat att 
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aktivera de ljuskallor som for tillfallet Sr aktuella for matning. Den nedan 
beskrivna utfor ingsf ormen av givaren 30 kan endast bestamma riktningen till 
en ljuskalla at gangen, och vid anvandning av denna typ av givare ar darfor 
styrsystemet anorrinat att pulsa de tre eller fyra anvanda ljuskallorna med 
lamplig frekvens och pa sadant satt att endast en ljuskalla at gangen ar 
tand. 

Av latt insedda 3kal blir noggrannheten i lagesbes tamningen stSrre ju narmare 
robothanden ljuskallorna ar anbringade. Det kan darfor vara lampligt att ha 
en uppsattning ljuskallor placerade pa sa stort avstand fran roboten att de 
kan anvandas inom robotens hela arbetsomrade och dSrutover en ytterligare 
uppsattning som ar sa placerad sa nara som mojligt intill den eller de 
arbetspunkter dar hog noggrannhet kravs. 

Fig 2a visar principen for givaren 30 i fig 1. Givaren har en vidvinkellins 
300, som ar symmetrisk runt givarens axel 301 . Linsen kan exempelvis vara 
approximativt halvsfarisk och ar sa utformad att den har en sa stor opp- 
ningsvinkel som mojligt. Foretradesvis bor oppningsvinke In vara minst 2* 
steradianer. VinkelrStt mot axeln 301 ar en plan t vadimensionel 1 fotodetek- 
tor 302 anordnad. Linsen avbildar en ljuskalla at gangen pa detektorn, dvs 
infallahde 1 jus 313 fran en ljuskalla bryts samman i en punkt 3 Hi pa detek- 
torn. Linsens brannvidd kan goras sa kort att tillrackligt god fokusering 
erhalles for alia aktuella 1 juskalleavstand . En viss oskarpa i avbildningen 
spelar ocksa mindre roll, eftersom den i fig 2a och 2b visade givaren be- 
stammer laget hos tyngdpunkten hos ljuskallans avbildning pa detektorn. 

Detektorn utgors som visas i fig 2b av en plan platta av kisei med ett cen- 
tralt egenledande skikt, ett pa oversidan anordnat P-ledande skikt och ett 
pa undersidan anordnat N*-ledande skikt. P-skiktet ar forsett med lang- 
strackta kontakter 305-306 respektive 303-304 vid sina motstaende sidor. 
N -skiktet ar forsett med en kontakt 307. Fotostrdmmens fordelning mellan 
de bada motstaende kontakterna bestams av resistansen och darmcd av av- 
standet fran ljusflacken till respektive anslutning. 

I fig 2a ar de vid berakningarna anvanda koordinatsystemen utsatta. Med 
hjalp av kontakterna 305 och 306 samt en forstarkare 310 och en A/D-omvanri- 
lare 312 erhalles en digital signal x, som ar ett matt pa ljusflackens av- 
stand i x-led fran axeln 301. Med hjalp av kontakterna 303 och 30'l , for- 
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starkaren 309 och A/ D-omvandlaren 311 erhalles pa motsvarande satt en digi- 
tal y, som ar ett matt pa ljusflackens avstand i y-led fran axeln 301. Med 
hjalp av signalerna x och y kan, som nedan narmare skall beskrivas, ljus- 
flackens lage pa detektorytan i polSra koordinater a, p bestammas. Ur dessa 
koordinater erhalles . sedan de sfariska koordinater <p, e som definierar rikt 
ningen hos syftlinjen 313 till den aktuella ljuskallan. 

I stallet fSr den i fig 2 visade tvadimensionella analoga detektorn kan 
andra motsvarande typer av detektorer anvSndas . Ett exempel ar en s k CCD 
(charge coupled devise) -detektor, vilken kan utforas tvadimensionell . Ett 
annat exempel pa en sadan detektor ar en s k f otodiodarray , vilken aven 
den kan utforas tvadimensionell. En fordel med en sadan array ar att man 
inte endast kan avkanna tyngdpunkten hos ljusflacken utan med hjalp av 
lamplig signalbehandling kan bestamma laget hos t ex den punkt hos ljus- 
flacken, dar ljusstyrkan ar maximal. 

Som ett alternativ till den i fig 2 visade givaren kan tva endimensionella 
givare anvandas. Dessa anordnas da med sina avkanningsriktningar foretra- 
desvis vinkelratt mot varandra och med givarna sa nara varandra som mSjligt . 
Varje givare bestar da av en cylinderlins och endimensionell f otodetektor , 
exempelvis en analog detektor eller en endimensionell diodarray. 

Fig 3 visar ett blockschema over lagesgi varutrustningen enligt uppf inningen . 
En styrenhet .50 avger klockpulser och eventuellt for samordping och synkroni 
sering ytterligare nodvandig information till utrustningens ovriga enheter. 
Denna information ar i figuren betecknad med cl. Givaren 30 ar utford enligt 
fig 2 och avger signaler x, y till enhetema 51. och 52. Enheten 52 ar en be- 
rakningsenhet, som med hjSlp av signalerna x, y samt lagrade data om bl a 
ljuska-llornas la'gen bera'knar information som definierar robothandens lage X 
och orientering Z. Berakningsenheten 52 bestammer Sven genom derivering av 
vektorerna X och Z hastighetsvektorerna _X och Z. Dessa fyra vektorer eller 
signaler tillfors robotens styrsystem for styrning av robotens rorelse . En 
ljuskallestyrenhet 51 har med var och en av ljuskallorna *Jl-iJ8 forbundna 
utgangar (endast ljuskallan ^1 ar visad i figuren). Denna styrenhet mottar 
information X och Z om robothandens lage och orientering samt information 
x, y om ljusflackens lage pa detektorn. I beroende av denna information ut- 
valjer styrenheten 51 lamplig uppsfittning ljuskallor och aktiverar dessa, 
foretradesvis genom periodisk pulsning med lamplig frekvens sa att endast en 
av de utvalda ljuskallorna at gangen ar lysande. Styrenheten 51 avger infor- 
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mation till berakningsenheten 52, vilken definierar den far tillfSllet ut- 
valda uppsattningen ljuskallor. 

Enheten 30 kan utforas pa det i fig 2 visade sattet. Enheten 50 kan utgoras 
av en enkel klockpulsoscillator edler av en pa lampligt satt programmerad 
mikrodator. Enheten 51 kan utgoras av en specialbyggd logisk koppling eller 
av en mikrodator. Berakningsenheten 52, sora skall utfora de nedan i samband 
med fig 7 beskrivna berakningsoperationerna , kan pa i och for sig kant satt 
besta av digitala eller analoga kretsar eller av en pa lampligt satt pro- 
grammerad mikrodator. 

Fig U visar hur lagesgivarutrustningen enligt uppfinningen ar ansluten till 
robotens styrsystem. Civaren 30 avger signalerna x, y till berakningsenheten 
52, vilken i sin tur beraknar en vektor X. som definierar robothandens lage . 
Denna signal tillfors en komparator 53- Till en andra ingang pa komparatorn 
matas lagesborvarden Xq f ran ' robot ens programverk 58 i lamplig takt. Fran 
komparatorn erhalles i varje ogonblick en signal AX som definierar lagesav- 
vikelsen hos robothanden. Denna lagesavvikelse tillfors en s k axeluppdelare 
5^, i vilken avvikelsen transf ormeras till robotens koordinatsystem , dvs 
delas upp pa ett fel i var och en av robotens axlar. Axe luppdelaren 5^ har 
alltsa en utgang for var och en av robotens axlar. I figuren ar endast ut- 
signalen - Ar^ - for axeln 1 visad . Denna signal tillfors axelns 1 regulator 
56. Fran enheten 52 erhalles aven en vektor £ som definierar den momentana 
hastigheten hos robothanden. I enheten 55 jamfors denna hastighet med ett 
borvarde X^ for hastigheten. Skillnaden mellan de bada varden som tillfors 
enheten 55 uppdelas dSrefter pa robotens olika axlar, dvs t ransf ormeras over 
till robotens koordinatsystem. Enheten 55 har en utgang for var och en av 
robotaxlarna , men endast utsignalen Ar for axeln 1 ar visad i figuren. 
Denna signal tillfors axelns 1 regulator 56. Regulatorri 56 styr pa i och 
for sig kant satt enheten 57, som innehaller ef f ekt forstarka re och driv- 
motor for axeln 1 . Utsignalen fran drivenheten 57 utgbrs alltsa av en vrid- 
ning hos robotens axel 1, och denna vridning - i figuren med figuren beteck- 
nad med y - paverkar i sin tur laget och ori enteringen hos robothanden och 
givarcn 30. Med hjalp av det i fig *J visade systemet kommer alltsa roboten 
att styras sa att givaren 30 foljer den bana som bestams av de successivt 
frammatade lagesborvardena fran programenheten 58. 

I fig *J har for enkelhets skull endast lagesbestamningen och -regleringen 
visats. Reglering av robothandens orientering kan goras pa motsvarande satt 
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i beroende av den information oro den verkliga ori enteringen Z som erhalles 
fran berakningsenheten 52 och av borvarden for orienteringen , vilka matas 
fram av programverket 58. 

Fig 5 visar nagra av de beteckningar, som anvands vid de berMkningar som 
utfors av berakningsenheten 52. Figuren visar schematiskt ytan hos detek- 
torn 302 i fig 2, sedd uppifran. Detektorns ratvinkliga koordinatsy stem 
x, y ar markerat, liksom de polara koordinaterna a, p f5r var och en av de 
tre ljuskallorna a, b, c. 

Fig 6 visar de tre ljuskallorna a, b och c, vilka i ett visst tidsavsnitt 
anvands for lages/orienteringsbes tamningen . Vektorerna A, B 1 och definie- ' 
rar-laget hos givaren^O, ljuskallan b respektive ljuskallan c i fdrhallande 
till ljuskallan a. Vektorn Mr vektorprodukten av vektorerna och B 2 . 
Vektorerna P fll P fa och definierar 1 juskallornas a, b och c lage i det 
koordinatsystem d3r ljuskSllorna ar anordnade . Vektorn X_ betecknar givarens 
3Q lage i samma koordinatsystem. 

Berakningsenhetens 52 funktion skall nu narmare beskrivas i anslutning till 
fig 7. Denna enhet kan utforas med specialbyggda kretsar for losning enligt 
kanda principer av de nedan angivna sambanden. Alternativt kan den utgoras 
av en pa lampligt satt programmerbar Cmikro ) dator . For overskad lighe t s skull 
antas det senare vara fallet, och fig 7 visar ett f lddesschema for beraknings- 
gangen hos en sadan (mikro )dator . 

De tre vid varje berakning anvanda ljuskallorna ger upphov till tre par av 
sammanhtirande x-y-varden pa ytan av detektorn 302. Vilka riktningar i rummet 
som motsvaras av dessa x-y-varden beror delvis pa utforandet av gi varoptiken . 
I fortsattningen antas for enkelhets skull att R i fig 2 ar konstant (obero- 
ende av e). Detta behover dock ej vara fallet, men berakningarna blir nagot 
mer kornplexa om sa inte skulle vara fallet. R(9) ar namligen ingen obekant 
storhet utan endast en ytterligare parameter att ta hansyn till vid berak- 
ningarna. 

Vid berSkningens borjan erhaller berakningsenheten information fran styr- 
enheten 51 om vilka tre ljuskallor som anvands vid berakningen. Dessa ljus- 
kallor betecknas med a, b, c. En ljuskallas "i" avbildning pa detektorytan har 
i dennas koordinatsystem laget x i y_. . Avbi ldni ngens lage i polara koordinater 
ges av foljande ekvationer: 
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a i = arctan + (1 " Tv 5 ' 1 



Ur dessa polSra koordinater erhalles sedan de 3fariska koordinaterna for 
syftlinjen till ljuskallan ur ekvationerna : 



5 (0 . = OL . 

3 1 

e. = f( P .) 

Funktionen f(P^) beror av optiken och kan en gang for alia uppmatas och lag- 
ras i berakningsenhcten . Optiken bor dock vara sa utformad att funktionen 
ar monoton i det aktuella intervallet. Harefter beraknas vinklarna T 1 , 
10 och mellan de tre syftlinjerna fran givaren till ljuskallorna med hjalp 
av foljandc ekvationer: 

i 

S = *b " 

15 (a, b, c antas ordnade sa att q> > 9 > cp ) 



T 1 = arcsin 



sin 6 



(sinC 1 ) 



(cot — )sm — - (cot — ) cos — - 

arctan ^ — = + arctan 



a b 



cos 



e +e 

a b 



T 2 = arcsin 



sin 0 



(sinC^) 



c 0 e -e c e -e 

, 2 . . c a , 2 v ca 

(cot — - ) sin — - ^ cot ~ COS — 2 

arctan — - + arctan 



sin 



G +6 
c a 



cos 



e +e 

c a 
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= arcsin 



sin 6 V 



(sinC 3 ) 



arctan 



(cot ^) sin 
b c 



+ arctan 



(cot -f- ) cos — ^ — 



COS 



e w +e 

b c 



F] odesschemats fyra forsta rutor har nu behandlats. I det femte steget bildas 



funktionerna G^A) enligt: 



G(A) = 



(cusT^ ) ( AcosT^ 



1 7b^-A 2 sin 2 T ) - Jbl- (AcosT, - 7b 2 -A 2 s: n 2 T_ ) 2 ( sin 2 T_ ) 



j^AcosT 1 - 7b 2 -A 2 sin 2 T 1 j 



dar b 1 ar avstandet mellan ljuskallorna a och b 
b^ ar avstandet mellan ljuskallorna a och c 
b^. ar avstandet mellan ljuskallorna c och b 



Denna funktion ar egentligen atta olika funktioner, en for var och en av de 

atta kombinationerna av tecken vid de tre stallen i uttrycket dar antingen 

ett plus- elier minustecken kan forekomma (tecknet framfor uttrycket 
I 1 

7b 2 - A 2 sin 2 T 2 har alltid samma varde pa de bada stallen dar uttrycket fore- 

kommer) . Dessa funktioner betecknas i f lodesschemats femte ruta med G^ ( A ) , 
dar i = 1 ... 8. For var och en av dessa funktioner bestammes nollstallen i 
de delar av funktionen, dar var och en av funktionens bada termer liksom 

AcosT t 7b 2 - A 2 sin 2 T 0 ar sa val reell (betecknas med v° > 0 i flodessche- 

2 2.2. 

mats sjatte ruta) som positiv (betecknas med [ ] 0 i f lodesschemats 
sjatte ruta). I nasta ruta undersoks hur manga nollstSllen som totalt har 
erhallits. Om endast ett nollstalle har erhallits gar berakningsprogrammet 
yidare till den med B, C bctecknade rutan i flodesschemat. Om mer an ett 
nolistallc har erhallits valjs i nasta punkt av berakningsschema t de noll- 
stallen bort dar A jamfort med foregaende berakningar skulle medfora en 
orealistiskt hog hastighet hos roboten. Om efter denna kontroll endast ett 
nollstalle aterstar gar berakningsprogrammet vidare till rutan B, C. Om 
fortfarande flera nollstallen ater3tar och om den aktuella passagen genom 
flodesschemat ar den forsta passagen utvaljs en ny grupp av tre lju3kallor, 

i flodesschemat betecknade med a, b, d. Om sa ar fallet gors den ovan 

i 

beskrivna berakningen om fran borjan for den nya gruppen av ljuskallor. 
Darefter utfores den nedan beskrivna lagesbestamn ingen for bada uppsatt- 
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ningarna av ljuskallor, varefter den losning valjes som ger en gemensam 
position. Om den aktuella passagen genom berakningsschemat inte ar den 
forsta passagen har enligt ovanstaende beskrivning berakning av noil- ' 
stallen gjorts for tva uppsattningar av ljuskallor, berakningen gar vidare 
enligt nedanstaende beskrivning och till slut den losning utvaljes som ger 
ett gemensamt lage for de bada uppsattningarna av ljuskallor. 

Enligt nasta steg i berakningen, betecknat med B, C i f lodesschemat , teck- 
nas forst uttrycken: 



- arccos 



y - arccos 



e = arccos 



•i 




B 2 










*■$- 


c 2 















dar A Q ar det varde pa A dar funktionen G( A) = 0 och B respektive C gives 
av uttrycken: 

B = A Q cosT 1 - Vb^ - A^sin 2 T 1 



»5 C = A Q cosT 2 t - A Q sin 2 T 2 



dar de dubbeltydiga tecknen i uttrycken for B och C valjes som tecknen i mot- 
svarande uttryck i den ekvation G\(A) som gav det aktuella nollstallet. Har- 
efler bildas storheterna s och k enligt: 



s = n + y + e 



20 k ,/ sin (s-T)sin (s-n )sin(s~e) ■ 

sin s 



samt storheterna x och 6 enligt uttrycken: 
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x = 2 arctan -7 

sin (s-t ) 

6 = arcsin (sinx sinn) 



varvid om x > Sn I losningen 6 > | vSljes och om x < | losningen 6 < | valjes. 

Som framgar av fig 6 ges riktningen fran ljuskallan a till b av vektorn 
och fran ljuskallan a till c av vektorn B^ Riktningen fran ljuskallan a till 
givaren 30 betecknas med enhetsvektorn A. Vektorn utgor vektorprodukten 
. av vektorerna B } och B g . - Vektorn A kan nu losas ur foljande ekvationssystem: 

B 1x B ly B l2 
3 2x B 2y B 2 2 
B 3x B 3 y B 3z 

Givarens 3 0 lage, vilket betecknas av vektorn X erhalles harefter ur: 




10 



X = A ■ A + P 
— 0 — —a 



Givarens 30 lage har nu bestamts. 



Harefter bestams givarens orient 



ering genom att foljande vektorer bildas: 



P a - X 



15 



Harefter erhalles komponenterna n 
3C 

\ 7 



V n b och n c hos no ™alvektorn till givaren 
detektoryLa 302 ur ekvat ionssystemet : 



(z z z 

ax ay az 

2^ 2 W Z 
bx by bz 



Z Z Z 
cx cy cz 




1 3 



8404246-4 



Givarens vridningsvinkel a runt denna normal till ytan erhalles till slut 
direkt ur nagondera av a^, och . 

Cm sa ar erforderligt erhalles darefter robothandens translations- och vrid- 
ningshastighet med hjalp av di f ferentiering av signalerna X och 2. 

Ovan har beskrivits hur gi varanordningen enligt uppfinningen anvands bade 
for lages- och orienteringsbestamning, men givetvis kan utrustningen enbart 
anvandas for lagesbestamning . 

I fig 1 har for enkelhets skull en industrirobot med endast fyra axlar 
visats, men. givetvis ar uppfinningen lika tillamplig aven vid robotar med 
ett annat antal f rihetsgrader . Uppfinningen ger vidare samma fordelar aven 
vid andra arbetsorgan an det i fig 1 visade gripdonet, t ex svetsutrust- 
ningar, bearbetningsverktyg, montageverktyg etc. 

Ovan har beskrivits hur vid den visade tvadimensionella analoga f otodetektorn 
ljuskallorna lampligen pulsas sa att endast en at gangen ar lysande. Vid en 
diodarray (CCD-array) ar en dylik pulsning ej nodvMndig, eftersom styrutrust- 
ningen enkelt kan. halla reda pa vilken av alia ljusflackar pa detektorn sora 
tillhor respektive ljuskalla, detta speciellt som roboten typiskt sett ror 
sig relativt langsamt. 

Givaren enligt uppfinningen kan utformas pa ett stort antal andra sStt &n det 
i fig 2 visade. Exempelvis kan den best! av en samling detektorrutor med mot- 
svarande optik, exempelvis sex stycken rutor av vilka var och en tacker 1/6 
av rymden (anordnade som sidorna i en kub). 

Sjalvfallet ar det sa att 1 juskallornas lagen enbart behover vara kanda 
relativt den arbetspunkt dit man onskar att roboten skall rora sig. Om 
arbetspunkten for roboten befinner sig pa ett rorligt foremal satts dar- 
for med forde] ljuskallorna fast pa detta, varigenom automatisk foljning 
av fdremalet erhalles. I detta fall torde det dock ofta vara lampligt att 
aven ha ett antal fasta ljuskallor sa att kontroll hela tiden erhalles pa 
robotens lage relativt ett fast koordinatsystem (sa att systemet inte dri- 
ver ivag) . Vaxlingen mellan dessa tva system kan ske kontinuer ligt , och 
styrsystemet kan exempelvis samtidigt halla reda pa robotens lage i bagge 
systemen men enbart styra robotens rorelse med hjalp av det ena systemet, 
fore tradesvis da det som ger den storsta noggrannhe ten (om detta ar mojligt). 
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Ljuskallorna bor enligt kanda geometriska principer fdr att erna hogsta moj- 
Uga -noggrannhet placeras sa att, nSr roboten befinner sig i si tt onskade 
arbetsomrade, ayftlinjerna mellan givaren och de anvanda Ijuskallorna bildar 
vmklar med varandra som inte ar alltfor sma . 

Uppfinningen har ovan beskrivits i anslutning till en utrustning som arbetar 
med optisk straining. Det ar darvid sjalvklart att den anvanda stralningen 
kan lig^a saval inom som utanfor det synliga vaglangdsbandet . En utrustning 
enligt uppfinningen kan emellertid anordnas att arbeta aven med andra signa- 
ler an 1JU3. Ett exempel pa en sidan signalform ar ultraljud. I detta fall 
ersatts Ijuskallorna i den ovan beskrivna anordningen med ultral judgeneratorer 
och gnvarna 3 0 etc med r iktningskannande ultral judmottagare . Berakningsgang 
och fordelar blir i detta fall desamma . 

Som framgar av ovanstlende beskrivning erbjuder en industrirobot enligt upp- 
nnnxngen stora fordelar jamfdrt med hittills kanda och anvanda robotar. 

Genom att robothandens lage direkt bestams av givaren, som Sr anordnad vid 
eller pi handen, erhalles en hog noggrannhet hos lagesbestamni ngen oberoende 
av tillverknings- och monteringstoleranser hos robotens delar och oberoende 
av fel i signalerna fran de i robotens olika axlar anordnade v inkelgivarna . 
Likasa bibehalles den hoga noggrannheten i lagesbestamningen oberoende av de 
deformationer som vid hog belastning eller hoga accelerationer kan upptrada 
i roboten. De.ssa fakta gdr det mojligt att astadkomma en robot" som trots be- 
tydligt lagre toleranskrav och styvhetskrav uppvisar en mycket hog noggrann- 
het i lagesbestamningen. 

En ytterligare vasentlig fdrdel hos uppfinningen ar att ett robotexempla r 
direkt kan utbytas mot ett annat, t ex vid dri f tavbrott , utan att nagon som 
heist omprogrammering erfordras. 

Cenom att de signalutsSndande organen (Ijuskallorna) lampligen kan anbringas 
fast forbundna med ett arbetsstyoke och nana den aktuella arbetspunkten for 
roboten erhalles den viktiga fordelen. att roboten automatiskt kommer att 
folja rorelser eller lagesa vvikelser hos arbetsstycket . Vidare erhalles genom 
att placera de signalutsandande organen nana arbetspunkten en mycket hog nog- 
grannhet i nSrheten av arbetspunkten, dar detta ar synnerligen onskvart, 
medan ISngre fran arbetspunkten en lagre noggrannhet erhalles, vilket kan 
accepteras utan olagcnheter. Cenom att enligt uppfinningen lagesbestanningen 
erhalles med dnskad hog noggrannhet utan att robotens fastsattningspunkt 
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behdver vara kand kan roboten i princip tillatas rora sig fritt i arbets- 
lokalen, varigenom dess arbetsomrade kan utstrackas hogst vasentligt jam- 
fort med tidigare kanda fasta eller begransat akbara robotar. 

Enligt en ytterligare variant av uppfinningen kan de ovan beskrivna signal- 
5 kallorna ( 1 juskallorna) vara passiva (aterutsandande eller ref lekterande) 

organ, varvid en signalutsandande anordning placeras pa annan plats, t ex 
vid givaren. 

Flera andra satt finns att anvanda en industrirobot enligt uppfinningen. 
Ett sidant satt ar att anvanda givaren enligt uppfinningen enbart som 

10 lagesgivare i reglerloopen och att anvanda konventionella hastighets- 

givare, t ex tachometrar i varje robotaxel , som hastighetsaterf oring for 
reglersystemet . Ett annat alternativ ar att anvanda givaren som komplement 
till konventionella lagesgivare for kalibrering eller kontroll, for att 
oka noggrannheten vid lagesbestamningen , eller for inmatning far att mdj- 

15 liggora utbyte av robotar. Ett ytterligare alternativ ar att enbart anvanda 
givaren som hastighetsgivare . 

Vid utbyte av en industrirobot mot ett annat exemplar, vilket skall utfora 
samma funktion pa samma stalle, ar det inte nodvandigt att signalkallornas 
lagen ar kanda. I detta fall ar det namligen endast nodvandigt for det nya" 
20 robotexemplaret att kunna aterinta de positioner, vid vilka lagena hos 

signalkallornas avbildningar pa detektorn 5verensstammer med de som er- 
holls vid den ursprungliga roboten i motsvarande positioner. 

PATENTKRAV 

1. Industrirobot (2) med ett flertal relativt varandra rorliga delar 
(21-25) och forsedd med en lagesgi varanordning (30, 52) som innefattar en 
med en av robotens rorliga delar (25) mekaniskt forbunden givare (30). 
Givaren (30) ar anordnad att mottaga signaler f ran en uppsattning (iJI-^ii) 
av minst tre skilda signalkallor , vilkas lagen relativt varandra ar kSnda. 
Varje signalkalla ar anordnad att utsanda signaler som fortplantar sig rat- 
linjigt over strackan mellan signalkallan och givaren (30). 
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Roboten kMnnetecknas av att givaren (30) innefattar organ (302, 209-312) 
anordnade att avge signaler (x, y) som definierar riktningen (e, <p) rela- 
tivt givaren hos syftlinjerna fran givaren till var och en av signalkal- 
lorna. Givaren innefattar vidare berakningsorgan (52) anordnade att till- 
foras nSmnda riktningsdef inierande signaler (x, y), att med ledning av 
dessa signaler bestamraa vinklarna mellan syftlinjerna fran givaren till 
signalkallorna och att utgaende fran namnda vinklar alstra information 
(X) som definierar givarens lage relativt signalkallorna. 

2. Industrirobot eniigt patentkrav 1, kSnnetecknad darav, 
att berakningsorganen (52) a> anordnade att utgaende fran namnda vinklar 
alstra information (n^, n fe , n c , a), som definierar givarens orientering 
relativt signalkallorna. 

3. Industrirobot eniigt nagot av fdregaende patentkrav, k a n n e - 

t e c k n a d darav, att signalkallorna utgors av kallor for elektromagne- 
tisk straining. 

4. Industrirobot eniigt nagot av foregaende patentkrav, k a n n e - 

t e c k n a d dSrav, att lSgesgi varutrus tningen ar forsedd med organ for 
periodisk aktivering av signalkallorna i tur och ordning sa att endast en 
av signalkallorna at gangen ar aktiverad. 

5. Industrirobot eniigt patentkrav 3, kanneteckn ; ad darav, 
att signalkallorna utgors av ljuskSllor och att givaren (30) innefattar 
ett linssystem (300) av vidvinkel typ , anordnat att avbilda ljuskallorna 

pa ett detektororgan (302), samt organ (309-312) anordnade att avge infor- 
mation (x, y) som definierar laget pa detektororganet av en ljuskSllas av- 
bildning, vilken information ar anordnad att tillforas berakningsorganen 
(52). 

6. Industrirobot eniigt nagot av patentkraven 3-5, kanneteck- 
n a d darav, att detektororganet utgors av en tvadimensionell detektor 
(302). 

7. Industrirobot eniigt nagot av patentkraven 3-5, kanneteck- 

n a d darav, att detektororganet utgors av tva endimensionella detektorer. 
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